int32 id
int32 color  #0是红色，1是蓝色
geometry_msgs/PoseStamped   Point_map
